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Chapter  1 
Introduction 


1.1  Approaches  to  Force  Control 


This  chapter  describes  briefly  why  force  control  is  important  for  robotic  manipula¬ 
tors.  It  then  describes  why  manipulators  designed  using  the  traditional  values  do  not 
perform  well  at  this  task.  A  novel  actuator  is  introduced  which  eases  some  of  the 
problems  of  the  traditional  actuators,  and  should  allow  better  force  control. 

In  order  for  a  robotic  manipulator  to  be  of  any  use  in  the  world,  it  needs  to  interact 
safely  and  controllably  with  it.  The  forces  between  the  robot  and  the  environment 
needs  to  be  controlled  so  that  neither  the  robot,  nor  its  workpiece  can  damaged 
from  normal  operation,  or  from  unexpected  collisions.  Some  tasks,  such  as  grinding, 
polishing  and  assembly,  inherently  require  the  control  of  the  force  between  the  robot 
and  its  environment. 

The  traditional  premise  for  good  robot  design  is  “Stiffer  is  better”.  A  stiff  ma¬ 
nipulator  allows  high  bandwidth  force  control  and  precise  position  control,  but  the 
stiffness  makes  force  control  difficult.  A  stiff  manipulator  can  exert  high  forces  from 
small  joint  displacements,  a  large  force  error  resulting  from  small  errors  in  position. 
Typically  the  size  of  the  joint  motions  to  apply  significant  forces  are  comparable  to  the 
resolution  of  the  joint  angle  sensors,  making  the  control  task  difficult.  The  situation 
is  exacerbated  by  the  high  gains  used  to  make  the  positional  errors  small.  These  two 
factors  often  place  the  system  on  the  brink  of  instability.  Many  researchers  in  force 
control  have  observed  instability  when  applying  forces,  especially  when  contacting 
hard  surfaces.  Interestingly,  they  have  solved  this  problem  by  wrapping  compliant 
coverings  around  the  endpoint  of  the  robot  to  reduce  its  effective  stiffness. 

The  situation  is  further  compounded  by  the  choice  of  actuator.  As  the  robots 
are  stiff,  their  links  tend  to  be  heavy,  so  large  forces  are  needed  to  accelerate  them. 
Electric  motors,  which  are  the  most  common  actuator  type  cannot  generate  large 
forces  at  low  speeds,  so  gear  reductions  need  to  be  used.  These  increase  the  power 
density  at  the  expense  of  introducing  friction,  noise,  backlash  and  torque  ripple  to  the 
system.  As  the  robot  is  stiff,  these  effects  will  be  transmitted  to  the  endpoint  of  the 
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robot,  giving  poor  performance.  A  further  disadvantage  is  that  the  gears  increase  the 
reflected  inertia  of  the  motor,  and  the  large  shock  loads  which  result  from  unexpected 

collisions  can  cause  the  gear  teeth  to  break. 

The  conclusion  from  this  is  that  stiff  actuators  and  robots  are  not  good  for  force 
control.  On  the  other  hand,  humans  are  good  at  force  control,  and  they  certainly 
have  no  problems  contacting  hard  surfaces!  The  essential  difference  is  that  humans 
are  a  low  stiffness,  low  bandwidth  system,  compared  to  the  high  bandwidth,  high 
stiffness  robot.  This  raises  the  possibility  of  sacrificing  bandwidth  and  stiffness  to 
achieve  better,  more  stable  force  control.  This  can  be  implemented  by  placing  an 
elastic  element  into  the  actuator,  as  illustrated  in  Figure  1-1. 


Series 


Load 


Figure  1-1:  Schematic  of  Series-Elastic  Actuator 


The  elasticity  has  the  effect  of  making  the  force  control  easier,  as  larger  deforma¬ 
tions  of  the  robot  structure  are  needed  to  exert  the  same  forces  as  a  stiff  robot.  It 
also  gives  back  to  the  motor  some  of  the  properties  that  were  lost  when  gears  were 

introduced.  _  _ 

The  elasticity  turns  the  force  control  problem  into  a  position  control  one,  which 

greatly  improves  force  accuracy.  Since  the  output  force  is  proportional  to  the  twist 
in  the  spring,  the  motor  position  determines  the  force.  As  position  is  more  easy  to 
control  through  a  gear  train  than  force,  the  effects  of  friction,  backlash,  and  torque 

ripple  are  reduced. 

The  control  action  reduces  the  reflected  inertia,  and  the  elasticity  low  pass  filters 
shock  loads,  protecting  the  gearbox  from  damage.  The  spring  also  filters  the  output 
of  the  actuator,  limiting  the  bandwidth  that  can  be  achieved.  As  discussed  above, 
low  bandwidth  control  is  sufficient  for  human-like  tasks  such  as  assembly. 

Introducing  series  elasticity  also  makes  stable  force  control  easier  to  achieve.  The 
motor’s  force  feedback  loop  can  operate  well  at  low  frequencies,  so  neither  the  motor 
nor  the  load  inertia  can  resonate.  At  high  frequencies,  where  the  feedback  loop  no 
longer  operates  well,  the  system  behaves  like  a  spring,  which  is  passive  and  so  stable. 
To  prevent  light  loads  resonating  on  the  spring  a  minimum  mass  is  required,  which 
is  easily  provided  by  the  unavoidable  mass  of  the  arm. 

The  use  of  series  elastic  actuators  should  improve  the  performance  of  robots  per¬ 
forming  human-like  tasks.  The  robot  structure  will  be  less  stiff,  and  the  force  control 
will  be  less  noisy,  more  accurate,  and  stable. 


1.2.  SCOPE  OF  INVESTIGATION 
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1.2  Scope  of  Investigation 

An  actuator  with  a  series  elastic  element  was  designed  and  built  to  evaluate  some  of 
the  claims  of  the  previous  section.  Theory  was  developed  to  attempt  to  understand 
the  performance  enhancements  and  limitations  that  the  spring  caused,  as  well  as  to 
determine  a  suitable  control  law  for  the  system.  Tests  were  carried  out  to  determine 
how  the  actual  actuator  performed  in  practice. 


1.3  Review  of  Thesis  Contents 

The  thesis  is  organized  as  follows: 

Chapter  2  describes  some  of  the  background  literature  on  force  control,  and  recent 
work  on  compliant  actuators. 

Chapter  3  examines  a  model  for  a  series  elastic  actuator,  and  considers  a  control 
strategy.  The  stability  of  the  actuator  is  demonstrated. 

Chapter  4  considers  the  performance  limits  of  an  actuator  with  an  elastic  element, 
and  compares  it  to  a  stiff  actuator.  The  possible  range  of  output  impedances  that 
the  system  can  produce  is  analysed. 

Chapter  5  describes  the  detailed  design  of  a  single  degree  actuator  based  on  these 
principles,  with  discussion  of  the  mechanical  hardware,  the  motor  and  spring,  and 
also  the  implemented  control  strategy. 

Chapter  6  describes  some  experimental  results  for  the  actuator,  including  system 
identification,  tuning  of  the  control  loop  and  assessment  of  the  performance  limits  of 
the  actuator. 

Chapter  7  describes  some  possible  applications  for  the  actuator,  in  the  arms  of  a 
humanoid  robot,  and  a  planetary  rover. 

Chapter  8  provides  conclusions  and  recommendations  for  further  work. 
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Chapter  2 

Literature  Survey 


This  chapter  reviews  the  literature  both  for  force  control,  and  early  work  on  elastic 
actuators.  It  details  different  methods  for  achieving  force  control,  be  they  placing  the 
force  control  sensor  at  the  endpoint  of  the  robot  or  closing  torque  loops  around  each 
joint.  It  discusses  the  problems  of  dynamic  instability  under  force  control  and  some  of 
the  ways  that  people  have  dealt  with  the  problem.  Some  work  on  controlling  flexible 
structures,  and  other  compliant  mechanisms  is  discussed,  and  the  chapter  concludes 
by  looking  at  the  types  of  actuator  used  for  robotic  applications. 

It  is  clear  that  to  perform  any  task  that  requires  interaction  with  the  environment 
the  force  that  the  manipulator  exerts  must  be  controlled  in  some  way.  There  are 
essentially  two  ways  to  do  this — to  provide  active  control  of  the  forces,  or  to  use  a 
passive  system  such  as  Remote  Centred  Compliance  (Drake  [13]).  The  active  methods 
have  had  been  the  focus  of  the  bulk  of  robotic  research  in  recent  years.  Whitney  [38] 
gives  a  good  review  of  force  control  methods. 

The  methods  described  by  Whitney  are  damping  control  (Whitney  [39]),  stiffness 
control  (Salisbury  [30]),  impedance  control  (Hogan  [17])  and  hybrid  position  and  force 
control  (Raibert  and  Craig  [25]).  These  methods  differ  in  the  way  that  they  calculate 
the  torques  to  be  applied  at  each  joint,  with  the  goal  of  achieving  a  desired  endpoint 
force.  The  control  of  the  joints  may  be  purely  feed  forward,  or  there  may  be  force 
sensors  and  a  force  control  loop  at  each  joint. 

The  question  as  to  where  the  force  should  be  sensed,  whether  at  the  joints  or  at 
the  end  effector,  has  been  addressed  by  a  number  of  authors.  Cannon  [8]  was  the  first 
to  investigate  non-colocated  sensors  (where  the  sensor  is  not  located  at  the  actuator 
to  be  controlled).  Cannon  showed  that  colocation  allows  good  stable  control,  while 
any  significant  dynamics  between  the  sensor  and  the  actuator  can  lead  to  instability. 
This  is  one  of  the  reasons  that  manipulators  have  been  made  designed  to  be  stiff, 
reducing  the  effect  of  the  arm  link  dynamics.  The  advantage  of  wrist  sensing  is  that 
a  direct  measurement  of  the  force  is  made,  rather  than  calculated  from  joint  torque 
information.  The  advantage  of  closing  torque  control  loops  around  the  joints  is  that 
the  system  is  likely  to  be  more  stable.  As  the  torques  are  being  controlled,  the  effects 
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of  friction,  torcpe  ripple,  etc  are  reduced.  An  [1]  suggested  a  combination  of  end 
point  and  joint  force  sensing,  closing  joint  torque  control  loops  to  obtain  stability, 
and  using  a  wrist  sensor  to  obtain  good  steady  state  force  accuracy. 

In  different  research  Eppinger  and  Seering  [14]  [15]  investigated  the  bandwidth 
limits  on  robot  force  control.  They  found  that  the  fundamental  limit  on  the  force 
control  bandwidth  is  the  link  stiffness.  Like  Cannon  [8]  they  found  that  non-colocated 
dynamics  can  lead  to  unstable  systems.  They  also  considered  the  effects  of  simple 
force  control  laws  on  a  model  of  an  actuator  and  the  environment.  Volpi  [36]  has 
undertaken  work  to  assess  the  performance  of  torque  control  schemes  under  a  variety 
of  simple  controllers,  using  an  experimentally  determined  transfer  function. 

One  problem  with  all  these  schemes  is  that  they  exhibit  instability  while  contact¬ 
ing  stiff  environments.  This  can  result  as  the  robot  changes  from  position  control, 
when  it  is  moving  freely,  to  force  control  when  in  contact  with  the  environment.  In 
addition  the  force  control  itself  can  exhibit  instability.  The  force  control  problem  has 
been  related  to  a  high  gain  position  control  (An  [1]).  The  model  of  the  manipulator 
and  the  environment  is  generally  considered  as  a.  fourth  order  sj^stem  which  is  very 
lightly  damped,  the  natural  frequency  being  related  to  the  mass  of  the  robot  and  the 
stiffness  of  the  environment  (Eppinger  and  Seering  [15],  An  [2]).  The  system  perfor¬ 
mance  improves  if  the  effective  stiffness  of  the  environment  is  reduced,  for  example 
by  covering  the  endpoint  of  the  manipulator  with  a  compliant  covering  (Roberts  [26] 
and  Whitney  [39]),  or  alternatively  by  increasing  the  damping  on  the  system. 

Other  methods  for  dealing  with  the  contact  instability  have  been  through  simple 
control  laws  (Volpi  [36],  Yousef- Toumi  [44]),  or  the  use  of  nonlinear  control  (Xu  et 
al.  [42])  to  alter  the  characteristics  of  the  control  system  so  that  low  gains  are  used 
when  the  force  is  moving  towards  the  setpoint,  and  high  when  it  is  moving  away. 
Wu  and  Paul  used  joint  torque  control  (Wu  and  Paul  [41]),  and  argued  that  joint 
force  control  gave  stability  and  high  performance.  Marth  [22]  used  an  event  based 
system  to  detect  contact  and  deal  with  it.  These  systems  depend  on  a  controller 
commanding  the  joint  torques,  depending  on  sensed  values  (such  as  whether  there  is 
contact),  so  their  behaviour  under  unexpected  collisions  is  not  good.  This  can  happen 
if  the  collision  occurs  on  an  arm  link  which  is  not  detected  by  the  wrist  force  sensor. 
Impedance  control  (Hogan  [17])  essentially  gives  the  actuators  a  dynamic  behaviour 
which  is  stable,  and  so  unexpected  collisions  are  dealt  with  more  safely. 

Hogan  [18]  and  Colgate  [11]  proved  that  for  any  system  to  stable  with  an  arbitrary 
environment,  then  it  must  look  like  a  passive  system. 

Robot  structures  will  always  have  some  compliance,  due  to  the  size  and  weight  of 
the  links,  and  perhaps  also  due  to  the  introduction  of  compliant  force  sensors.  Work 
has  been  done  on  controlling  the  position  of  structures  with  flexibility  (Cannon  [9], 
and  a  review  is  in  Balas  [4]),  and  the  position  control  of  manipulators  with  flexibility 
at  the  joints  (Spong  [31],  Lee  et  al  [21],  Chen  [10]). 

In  recent  years  more  work  has  been  done  on  actually  putting  compliance  into 
the  manipulator,  achieving  a  similar  purpose  to  the  compliant  coverings  mentioned 
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above.  Xu  et  al,  [43]  used  a  six  degree  of  freedom  wrist  with  a  passive  compliance  and 
an  active  sensing  mechanism.  Hashimoto  [16]  used  an  parallel  compliant  mechanism. 
Sugano  [32]  used  a  variable  rate  spring  to  adjust  the  compliance  of  his  robot  finger. 
This  work  allows  the  manipulator  compliance  to  be  altered.  However,  unlike  the 
work  described  in  this  thesis,  the  compliance  is  not  controlled  in  these  cases,  position 
rather  than  force  being  controlled.  Work  on  parallel  elastic  actuators  is  in  progress 
by  Morrell  and  Salisbury  [23]. 

There  has  also  been  work  on  the  choice  of  actuation  method  (Hunter  at  al  [19]). 
Electric  motors  have  been  the  most  common  type,  although  pneumatic  and  hydraulic 
systems  have  also  been  used  (examples  are  Raibert  [24],  Waldron  [3^],  and  Conrad 
[12]).  Most  electric  motors  have  poor  power  density  and  can  only  obtain  high  power 
density  by  operating  at  high  speed.  To  accelerate  or  move  heavy  loads,  step  down 
gearboxes  are  used,  however  these  introduce  friction,  torque  ripple,  noise  and  back¬ 
lash.  Harmonic  drive  gearboxes  offer  a  significant  improvement  in  backlash,  but  they 
have  high  friction,  and  non-linear  stiffness  elfects  (Tuttle  [35]).  The  disadvantages  of 
gears  have  lead  some  authors  to  use  direct  drive  motors  (Asada  [3]).  Salisbury  [29] 
and  Townsend  [34]  have  had  considerable  success  using  cable  transmissions,  which 
have  the  advantage  of  not  having  any  backlash,  and  reduced  friction. 
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Chapter  3 

Control  and  Modeling 


3.1  Introduction 

This  chapter  describes  a  model  of  the  actuator,  and  considers  what  control  law  should 
be  used  to  achieve  stability  and  good  performance.  The  control  law  which  was  used 
has  two  main  components,  feedforward  terms,  and  a  servo  loop,  both  of  which  are 
discussed  in  the  following  sections.  In  order  to  investigate  the  stability  of  the  actuator 
while  in  contact  with  all  environments,  the  concept  of  mechanical  impedance  is  used, 
which  is  explained  and  justified  in  section  3.4.1. 


3.2  Model  of  Actuator 

A  simple  model  for  an  actuator  with  a  series  elastic  element  is  shown  in  Figure  3-1 
below.  Shown  are  the  model  of  the  motor  mass  J-m-,  the  spring  with  stiffness  the 
force  on  the  motor  JA,  and  the  output  force  Ti.  The  movement  of  the  motor  shaft, 
and  the  load  are  9m  and  6i  respectively. 

ks  r 

— AWV — 

V  y  V 

Figure  3-1:  Model  of  actuator 

Some  relations  are  immediately  forthcoming  from  the  diagram,  by  applying  Newton’s 
Laws. 

Trrt  -f  ks{9l  —  9m)  —  Jm  '^m  (^-l) 
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=  Ti  (3.2) 

By  taking  Laplace  transforms,  an  expression  relating  Tm  and  T;  can  be  found: 

Tm{s)  =  (1  +  ^s^)Tiis)  +  (3.3) 

rCs 

This  equation  is  important,  as  it  shows  what  motor  torques  are  needed  to  give  an 
output  torque  of  T/,  when  the  output  of  the  actuator  is  moving.  This  equation  will 
be  considered  in  more  detail  when  the  performance  limits  of  the  motor  are  considered 
in  Chapter  4.  It  also  shows  what  the  components  of  nre,  some  of  which  can  be  a 
feedforward  part  of  the  control  scheme,  as  described  in  the  following  section. 

If  the  output  of  the  actuator  is  assumed  clamped  [Oi  —  0),  then  the  transfer 
function  between  output  torque,  and  motor  torque  is 


—  {s)  = - — —  (3.4) 

Tm  1  +  ^^Jm/ks 

Thus  the  transfer  function  between  the  actual  output  force  T/  and  the  motor  force 
Tm  has  no  zeros,  and  two  poles  on  the  imaginary  axis,  at  a  frequency  w  ~  yksjjm 
which  corresponds  to  the  natural  frequency  of  the  motor  mass  and  the  spring. 

The  transfer  function  between  the  motion  of  the  output  shaft  9i  and  the  output 
force  Ti  can  also  be  written,  and  is  shown  below.  The  ratio  Ti/Oi  is  also  defined  as 
the  impedance  Z  of  the  system,  looking  from  the  output.  The  impedance  will  be 
considered  in  more  detail  in  section  3.4.1,  where  the  stability  of  the  control  system  is 
analysed.  This  transfer  function  has  the  same  poles  as  the  Ti/Tm^  but  it  also  has  two 
zeros  at  the  origin.  The  negative  sign  comes  from  the  definition  of  the  directions  of 
Ti  and  ^i. 

These  two  equations  define  the  model  of  the  plant  to  be  controlled,  as  shown  in  the 
figure  3-2.  The  motion  of  the  output  shaft  is  modeled  as  a  disturbance  on  the  output 
torque. 


3.3  Feedforward  Model 

Tm{s)  =  (1  +  - — s'^)Tl{s)  +  Jms'^0l{s) 

kg 

The  equation  above  (which  is  3.3  rewritten)  defines  how  the  force  on  the  motor  mass 
needs  to  vary  to  give  an  output  torque  Ti  while  the  output  shaft  is  moving.  The 
motor  torque  is  made  up  of  a  component  T)  for  dc  behaviour,  {Jm/ks)Ti  to  accelerate 
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the  mass  of  the  motor  against  the  spring,  and  JmOi  to  cancel  out  the  movement  of  the 
output  shaft.  Alternatively  the  components  can  be  viewed  in  terms  of  the  wrapup  of 
the  spring,  the  Ti  term  to  provide  the  correct  wrapup,  because  torque  is  proportional 
to  angle  ,  the  {Jm/ks)fi  term  to  cancel  out  the  effect  of  the  motor  mass  vibrating 
on  the  spring,  and  the  Jm$i  term  to  move  the  motor  shaft  with  the  output  shaft, 
maintaining  the  same  spring  wrapup. 

This  equation  is  also  useful  as  it  describes  the  form  of  the  control  action.  By 
calculating  the  control  using  the  equation,  and  using  a  feedback  loop  to  compensate 
for  errors  in  the  model  and  unmodeled  disturbances,  a  closed  loop  system  will  be 
obtained  with  better  performance  than  one  using  feedback  alone. 

The  actual  feedforward  model  which  was  used  on  the  experimental  actuator  is 
described  in  Chapter  5,  section  5.7. 


3.4  Feedback  Control  Scheme 

The  feedback  control  is  required  to  increase  the  performance  of  the  system,  to  com¬ 
pensate  for  errors  in  the  feedforward  model,  and  to  reject  unmodeled  disturbances.  It 
is  important  that  the  system  is  stable,  and  but  perhaps  more  importantly,  the  system 
must  be  stable  when  in  contact  with  all  environments. 

3.4.1  Impedance  and  Stability 

Colgate  [11]  and  Hogan  [18]  have  shown  that  the  important  measure  for  determining 
whether  a  system  will  be  stable  while  in  contact  with  an  environment  is  the  output 
impedance  of  the  system. 

The  impedance  can  be  defined  in  a  number  of  ways,  either  as  the  ratio  of  force  and 
position  {Ti/6i)  which  is  used  in  this  thesis,  or  the  ratio  between  force  and  velocity 
(Ti/Oi).  The  impedance  is  given  the  symbol  Z,  and  is  generally  a  complex  number, 
positive  real  impedance  corresponding  to  mass  like  behaviour  (T;  =  Mw^6i),  and 
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negative  real  impedance  to  spring  like  behaviour  (T/  =  —k6i).  A  negative  imaginary 
impedance  corresponds  to  a  damper  (T;  =  —jwcOi). 

Colgate  and  Hogan  proved  that  a  system  will  be  stable  in  contact  with  all  envi¬ 
ronments  if  and  only  if  the  interaction  impedance  Z(s),  defined  as  Z{s)  =  Ti{s)/0i{s) 
obeys  the  following  rules. 

•  Z{s)  has  no  poles  in  the  right  half  plane  {Z{s)  is  stable) 

•  The  imaginary  part  of  Z{jw)  is  negative  for  all  frequencies  w 

These  rules  imply  that  the  impedance  is  a  stable  function  of  frequency,  and  that 
the  S3^stem  is  passive.  A  passive  system  is  one  that  always  absorbs  energy  from  the 
environment,  there  never  being  a  net  transfer  of  energy  out  of  the  system. 


3.4.2  Proportional,  Integral  and  Derivative  Control 

The  system  to  be  controlled  is  second  order,  and  so  PD  or  PID  controllers  would  be 
suitable.  PD  control  can  easily  be  shown  to  be  stable,  but  unless  the  proportional  gain 
is  high,  the  steady  state  error  is  large.  The  gain  cannot  be  raised  without  limit  due  to 
noise,  and  the  sampling  rate  of  the  system  controller.  PID  on  the  other  hand  allows 
better  low  frequency  behaviour  without  the  choice  of  high  gains.  A  PID  controller 
was  tested  and  is  evaluated  below. 


Figure  3-3:  Closed  loop  system 


Assuming  that  the  PID  is  of  the  form  A"(l  +  l/-sTi  -1-  sTd)^  then  the  closed  loop 
system  is  illustrated  in  Figure  3-3,  and  the  expression  for  the  impedance  is 


Z(s) 


Ti(s) 

e,(3) 


J  h 

+  A  (1  +  sTd  1/ sTi) 


(3.6) 
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So  first  checking  that  the  impedance  has  no  poles  in  the  right  half  plane,  considering 
the  characteristic  equation 

s^TiJm/ks  +  s\KTTd)  +  sT{K  +  1)  +  1  =  0  (3.7) 

This  will  have  roots  in  the  left  half  plane  if 

T'  1 

'  ^  k,TTi  ~ 

so  the  condition  for  stability  for  all  K  >  0  is 

l/{TTd)  <  K/J„, 

The  system  can  be  made  stable  even  if  this  is  violated  by  a  suitably  large  choice  of  A . 
The  other  part  of  the  stability  proof  considers  the  imaginary  part  of  the  impedance. 
Equation  3.6  rewritten  with  s  =  jw  is 


Z{jw)  = 


Ti  ( j  m J m  ks 

OiiJw)  ^  -wUm  +  k,  +  A(1  +  jwTd  +  l/jwTi) 


The  only  imaginary  terms  come  from  the  PID  term,  so  for  the  imaginary  part  of  the 
denominator  to  be  positive, 

wTd - ^  >  0 

u)  -L  i 

or 

TdT  >  -7 

which  is  impossible  for  all  ro,  since  Td  and  T  are  finite.  A  good  way  to  deal  with  this 
is  to  roll  of  the  integral  term  at  low  frequencies,  making  the  controller  be  K(s)  = 
j{(^l  +  1  /sTi{l  +  r)  +  sTd).  The  calculation  to  ensure  that  the  poles  of  the  closed  loop 
system  are  stable  is  more  messy  for  this  compensator: 


k^TdTil+r) 


Jm'T^  Iks  +  1 
1  +  T 


again,  K  and  the  other  time  constants  can  be  selected  to  make  the  system  stable. 
The  imaginary  part  of  this  controller  is 

wTd  -  ,  ^  >  0 

Ti{w^  +  r2) 

which  translates  to  the  condition  on  r  of 


> 
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and  so  the  final  condition  on  r  for  stability  over  all  w 


T  > 


If  this  condition  on  T,  and  Tj,  is  followed,  then  the  gains  for  stability  can  be  calcrdated 
using  the  equation  above. 

Unfortunately  rolling  off  the  integral  term  at  very  low  frequencies  gives  a  steady- 
state  error,  but  the  extra  flexibility  of  the  choice  of  /v ,  T  and  Td  allows  better  closed 
loop  performance  than  would  be  possible  if  the  integral  term  was  left  out  altogether. 

Included  below  is  a  plot  showing  the  closed  loop  transfer  function  for  the  case 
where  ^JljTiTd  =  11.83.  They  show  that  when  T  —  12  is  selected  as  per  the  guideline 
above,  the  phase  of  the  impedance  is  always  zero  or  negative,  while  for  the  invalid 
r  —  2,  the  phase  goes  above  zero,  corresponding  to  non-passive  like  behaviour. 


Comparison  of  impedance  for  different  values  of  tau 


Frequency  rad/sec 


Figure  3-4:  Plot  of  impedance  for  legal  r 
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3.5  Proposed  Control  System 

In  the  figure  below  is  included  a  drawing  of  the  proposed  control  scheme  -  it  includes 
the  feedforward  terms  and  the  PID  control  loop. 


r 


Figure  3-5:  Proposed  control  system 
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Chapter  4 

Performance  Limits 


4.1  Introduction 

Whenever  an  actuator  with  a  series  elastic  element  applies  a  certain  force,  the  motor 
must  move  to  achieve  the  desired  wrapup  of  the  spring.  If  the  output  shaft  moves, 
the  motor  must  move  together  with  that  to  maintain  the  same  force.  Thus  the  actual 
motor  motion  is  the  sum  of  that  required  to  generate  the  force,  and  that  required  to 
follow  the  output  shaft.  In  the  case  of  a  stiff  actuator,  the  only  motion  required  of 
the  motor  is  that  of  its  output  shaft. 

As  the  desired  force  waveform  and  the  output  motion  will  change  in  size  and  phase 
during  normal  operation,  the  extra  motor  motion  required  in  the  elastic  case  may  add 
either  constructively  or  destructively  to  the  actual  motor  motion,  so  either  increasing 
or  decreasing  the  bandwidth  of  the  force  control.  This  chapter  considers  the  effect 
of  the  extra  motion,  and  determines  what  effect  that  has  on  the  performance  of  the 
actuator.  A  comparison  is  made  between  an  elastic  and  a  stiff  actuator. 

The  treatment  that  follows  considers  a  simple  saturation  model  of  the  motor, 
where  the  maximum  current  and  so  the  maximum  torque  (due  to  yielding  in  the 
spring,  or  gearbox  limits)  is  limited.  The  range  of  forces  and  motions  that  the  actuator 
can  produce  is  measured  subject  to  the  limits  on  the  motor  current.  This  analysis  is 
informative,  and  provides  a  good  way  of  looking  at  the  performance  of  the  actuator. 
Also  considered  is  voltage  saturation  of  the  motor  power  supply. 


4.2  Current  Saturation 

In  the  model  of  the  actuator  described  in  Chapter  3,  an  expression  was  developed  for 
how  the  force  on  the  motor  mass,  and  so  the  current  in  the  motor  coils  depends  on 
the  output  force  and  load  motion.  The  equation  (3.3  in  chapter  3)  is  rewritten  below. 

TM  =  (1  +  +  JmS^Olis)  (4.1) 

rvg 
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putting  s  =  jw  gives  the  equation  relating  the  current  to  the  forces  and  motions  in 
terms  of  the  frequency  w. 

T^{s)  =  (1  -  ^w^)Ti{s)  -  JmW^eiis)  (4.2) 

One  way  to  understand  the  meaning  of  this  equation  is  to  draw  vectors  in  the  complex 
plane  representing  the  force  T/  and  the  motion  Oi.  One  such  figure  is  illustrated  in 
Figure  4-1.  In  order  to  satisfy  the  constraint  condition  T„i  <  Tmax-,  the  endpoint  vector 
Tm  must  lie  in  the  circle  of  radius  Tmax-  The  -{JmW^ t ks)Ti  term  always  opposes 
Ti^  so  at  low  frequencies  the  elasticity  moves  the  starting  point  of  the 
vector  closer  to  the  the  centre  of  the  circle,  so  allowing  a  wider  range  of  forces  and 
amplitudes  than  for  a  stiff  actuator.  Performance  at  frequencies  below  the  natural 
frequency  will  be  better  when  the  Om  vector  is  pointing  in  the  same  direction  as  the  Ti 
vector,  corresponding  to  mass  like  behaviour,  while  at  frequencies  above  the  natural 
frequency,  the  system  will  behave  better  when  they  point  in  different  directions, 
corresponding  to  spring  like  behaviour. 


Figure  4-1:  Phase  diagram  of  motor  forces 


Another  way  to  look  at  equation  4.1  is  in  terms  of  the  impedance  of  the  actuator, 
which  is  discussed  in  chapter  3.  The  equation  for  the  motor  force  can  be  rewritten  in 
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(4.3) 

(4.4) 


This  function  has  a  zero  at  Z  =  0,  and  assuming  that  we  are  not  at  the  natural 
frequency  (tc  =  a  pole  at  Z  =  JmW^/{l  -w^JmlK)  which  corresponds 

to  the  natural  impedance  seen  by  the  load  with  the  motor  unpowered  (see  equation 
3.5).  The  zero  corresponds  to  the  difficulty  of  generating  significant  force  at  zero 
impedance  (would  require  large  or  infinite  motions),  and  the  pole  corresponds  to  the 
condition  where  force  can  be  generated  for  zero  motor  current,  so  infinite  force  can 
be  generated  for  no  effort. 


Current  saturation,  frequency  =  10  rad/sec 


Real{Z)  Nm/rad  Imag(Z)  Nm/rad 


Figure  4-2:  Maximum  force  v.  impedance  for  below  the  natural  frequency 


Examining  the  characteristics  of  this  formula  in  more  detail  show  that  at  frequen¬ 
cies  below  the  natural  frequency  all  impedances  except  those  near  Z  =  0  may  be 
generated  at  the  full  motor  force.  Indeed  when  w  is  small,  the  spring  has  no  effect, 
and  it  is  easy  to  generate  impedances  close  to  the  motor  mass  Z  =  A  plot  of 

the  motor  force  output  versus  impedance  is  shown  in  Figure  4-2.  The  pole  position  is 
not  clear  as  the  force  output  has  been  limited  by  the  gearbox  maximum  torque  and 
the  spring  yield  point.  As  discussed  above,  generating  significant  force  near  Z  =  0 
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Current  saturation,  frequency  =  37.3  rad/sec 


Real(Z)  Nm/rad  Imag(Z)  Nm/rad 


Figure  4-3:  Maximum  force  v.  impedance  at  the  natural  frequency 


Current  saturation,  frequency  =  100  rad/sec 


Real(Z)  Nm/rad  1°°  -100  Imag(Z)  Nm/rad 


Figure  4-4:  Maximum  force  v.  impedance  for  above  the  natural  frequency 
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requires  very  large  motions,  and  is  difficult  regardless  of  the  stiffness  of  the  actua¬ 
tor.  At  the  natural  frequency  of  the  system  (w  =  yjksjjm)i  pole  disappears,  and 
the  ability  to  generate  force  just  becomes  a  simple  function  of  the  impedance  (see 
Figure  4-3).  Above  the  natural  frequency  the  pole  reappears,  and  as  w  gets  large 
moves  towards  Z  =  —kg.,  corresponding  the  the  impedance  of  the  spring  alone  (see 
Figure  4-4). 

Frequency  =  10  rad/sec 


Real(Z)Nm/rad  ’0°  -100  Imag(Z)  Nm/rad 


Figure  4-5:  Comparison  of  stiff  and  elastic  actuators  at  low  frequency 


4.3  Comparison  to  a  Stiff  Actuator 


The  equation  which  governs  the  output  force  of  a  stiff  actuator  as  its  impedance  varies 
is  similar  to  that  described  above,  except  that  there  is  no  pole  associated  with  the 


spring: 


Ti 


Tm.Z 

Z  -  w‘^Jm 


(4.5) 


The  stiff  actuator  has  problems  generating  significant  force  at  Z  =  0,  and  it  is  partic¬ 
ularly  good  at  generating  the  impedance  of  its  own  mass  Z  =  JmW^.  The  ratio  of  the 
output  forces  for  the  stiff  and  the  elastic  actuator  is  given  by  the  following  equation: 


Ti  _  _ Z  -  vPJm _ 

Tistijj  (1  -  w‘^Jmlks)Z  -  w'^Jm 


(4.6) 


The  plots  showing  the  behaviour  of  this  equation  are  included  in  Figures  4-5,  4-6 
and  4-7.  They  are  similar  to  the  previous  ones  except  that  the  zero  has  moved  from 
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Frequency  =  37.3  rad/sec 


Real(Z)Nm/rad  1“  -100  Imag(Z)  Nm/rad 

Figure  4-6:  Comparison  of  stiff  and  elastic  actuators  at  the  natural  frequency 


Frequency  =100  rad/sec 


Real(Z)  Nm/rad  100  -100  lmag(Z)  Nm/rad 


Figure  4-7:  Comparison  of  stiff  and  elastic  actuators  at  high  frequency 
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Z  =  0  to  Z  =  JmW^,  indicating  that  the  series  elastic  actuator  cannot  match  the 
unlimited  performance  of  the  stiff  actuator  at  generating  impedances  close  to  the 
motor  mass  (Jm),  where  the  stiff  actuator  needs  no  power  at  all.  The  elastic  actuator 
can  generate  those  impedances,  but  they  require  some  motor  power. 

At  low  frequencies,  as  shown  in  Figure  4-5,  the  performance  of  the  stiff  and  the 
elastic  actuators  are  the  same  for  all  impedances.  As  the  frequency  increases  to  the 
natural  frequency  of  the  elastic  actuator,  there  is  a  wide  range  of  impedances  for 
w'hich  the  elastic  actuator  performs  better  than  the  stiff  one  (see  Figure  4-6).  It 
performs  better  away  from  the  impedance  of  the  motor  mass  (it  cannot  match  the 
unlimited  performance  of  the  stiff  actuator,  as  discussed  above).  Figure  4-7  shows  the 
comparison  at  high  frequencies.  Here  the  elastic  actuator  is  behaving  like  a.  spring, 
and  so  is  a  lot  better  at  generating  those  impedances  than  the  stiff  one.  At  other 
impedances,  the  stiff  actuator  performs  better.  These  plots  show  clearly  both  the 
advantage  and  the  penalty  of  introducing  the  spring. 


4.4  Velocity  Saturation 

In  order  to  model  the  effects  of  the  motor  saturation  due  to  the  voltage  applied  to  it, 
the  motor  model  in  Figure  4-8  was  used. 


sL 


V 


Figure  4-8:  Motor  model 


The  voltage  V  is  given  by 

V  =  {R  +  sL)I  A  Kmfw  (4.7) 

where  R  is  the  resistance  of  the  motor  windings,  L  their  inductance,  /  the  motor 
current,  Kemf  the  back  emf  constant,  and  w  the  speed  of  the  motor.  The  torque  T^ 
is  related  to  the  current  by  Tm  =  Km  I,  so  the  saturation  condition  (equation  4.1)  can 
be  written 

V  =  {Tl{l  +  S^Jm/ks)  +  S-^Jmei)  +  sICmfOm 


(4.8) 
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Voltage  saturation,  frequency  =  10  rad/sec 


ReaI{Z)  Nm/rad  Imag(Z)  Nm/rad 


Figure  4-9:  Velocity  saturation  below  the  natural  frequency 


At  low  frequencies  (Figure  4-9)  there  is  no  velocity  saturation  except  at  very  low 
impedances  (where  as  discussed  before  there  are  large  motor  motions).  Figure  4-10 
shows  a  plot  at  the  natural  frequency  of  the  system.  The  effect  of  the  spring  is  to 
make  the  motor  motion  greater  for  impedances  with  negative  real  parts  than  for  those 
with  positive  ones,  giving  a  velocity  limit  over  the  mass-like  part  of  the  impedance 
diagram.  The  back  emf  is  dependent  on  the  velocity  of  the  motor  motion,  which 
corresponds  to  a  rotation  of  7r/2  on  the  impedance  plot.  Thus  the  velocity  saturation 
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Voltage  saturation,  frequency  =  37.3  rad/sec 


Real(Z)  Nm/rad  1“  -100  lmag{Z)  Nm/rad 

Figure  4-10:  Velocity  saturation  at  the  natural  frequency 


Voltage  saturation,  frequency  =  100  rad/sec 


Real(Z)  Nm/rad  Imag(Z)  Nm/rad 


Figure  4-11:  Velocity  saturation  above  the  natural  frequency 
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graph  is  not  symmetric  about  the  real  axis. 

Figure  4-12  shows  the  difference  in  the  movement  of  the  output  shaft  of  the  motor 
for  a  stiff  actuator,  and  the  experimental  actuator.  It  indicates  very  well  both  the 
advantage  and  the  penalty  of  using  the  spring,  for  impedances  with  a  positive  real 
part,  corresponding  to  spring  like  behaviour,  the  elastic  actuators  motor  moves  less 
than  the  stiff  one,  thus  higher  forces  can  be  generated.  In  the  other  half  of  the 
impedance  plane,  the  elastic  actuator  has  to  move  more  than  the  stiff  one,  as  so  its 
performance  is  less  good. 


Motor  motion  -  springy  actuator  Motor  motion  -  stiff  actuator 


Figure  4-12;  Motor  movement  for  a  stiff  and  an  elastic  actuator 

At  high  frequencies  (Figure  4-11),  the  only  place  where  the  motor  does  not  saturate 
is  where  the  system  is  acting  like  a  spring,  where  the  motor  motion  is  small. 


4.5  Discussion 

For  the  particular  parameters  of  the  motor  chosen  for  this  application  (see  chapter  5), 
the  current  limit  is  more  severe  than  the  voltage  limit.  This  is  because  the  actual 
output  torque  is  limited  by  the  strength  of  the  gearbox  teeth,  and  the  yield  strength  of 
the  spring,  rather  than  the  maximum  current.  Indeed  the  theoretical  maximum  torque 
(stall  torque  times  gearbox  ratio,  assuming  that  everything  is  perfectly  efficient)  is 
approximately  four  times  the  strength  of  the  gearbox  teeth.  This  factor  gives  a  lot  of 
leeway  on  the  voltage,  and  makes  the  voltage  saturation  not  important  in  this  case. 
In  other  applications,  it  may  well  become  significant. 


Chapter  5 

Actuator  Design 


5.1  Introduction 

This  chapter  describes  the  build  of  a  series  elastic  actuator.  The  specification  for 
the  actuator  was  determined  by  its  eventual  application  as  part  of  the  arm  for  the 
humanoid  robot  Cog[7].  This  application  is  described  in  Chapter  7.  Figure  5-1 
shows  a  photograph  of  the  final  actuator  design.  It  consists  of  an  electric  motor 
and  a  spring  instrumented  with  strain  gauges.  The  actuator  has  a  maximum  output 
torque  of  4Nm.  The  following  sections  of  this  chapter  describe  in  detail  the  choice 
of  motor,  the  design  of  the  series  spring,  the  control  hardware  that  was  used,  as 
well  as  the  control  algorithms  implemented  on  the  actuator.  Chapter  6  describes  the 
experimental  results  obtained  with  this  actuator. 


Figure  5-1:  Photograph  of  actuator 
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5.2  Choice  of  Motor 

The  considerations  which  were  taken  into  account  while  choosing  the  motor  and  the 
gearbox  were  the  power  of  the  motor,  the  expected  output  speed  of  the  motor-gearbox 
system  under  full  load,  and  the  maximum  allowable  output  torque.  Motors  from  a 
number  of  manufacturers  were  considered,  using  a  spreadsheet  to  perform  the  design 
calculations.  Details  of  the  chosen  motor  are  given  below. 


Motor — MicroMo  3557K 

Power 

25W 

Voltage 

48V 

Torque  constant 

0.086Nm/Amp 

Stall  Torque 

0.177Nm 

No  load  speed 

5200rpm 

Weight 

275g 

Efficiency 

0.74 

Inertia 

4.59  X  10“®Kgm^ 

Gearbox — MicroMo  30/1 

Reduction 

66:1 

Continuous  maximum  torque 

1.8Nm 

Intermittent  maximum  torque 

2.4Nm 

Efficiency 

0.60 

Gearbox  weight 

171g 

Expected  speed  with  4Nm  load 

27.0rpm 

Table  5.1:  Characteristics  of  chosen  motor  and  gearbox 


It  was  found  that  the  main  limiting  factor  in  the  choice  of  the  gearbox  was  the 
strength  of  the  output  teeth.  A  safety  factor  of  1.5  was  used  in  the  design  calculations, 
after  representatives  of  MicroMo  confirmed  that  the  data  was  conservative. 

The  motor  was  purchased  with  an  encoder  HEDS  5010,  to  allow  the  position  of 
the  motor  output  shaft  to  be  measured  accurately.  The  number  of  lines  required 
(360)  was  determined  by  the  reduction  ratio  of  the  gearbox,  and  encoder  decoding 
circuitry  that  was  used  (16  bit). 


5.3  Spring  Design  and  Development 

The  design  of  the  spring  was  by  far  the  most  difficult  part  of  the  design.  As  the 
spring  is  in  series  with  the  output  and  carries  the  full  actuator  load,  it  is  important 
that  it  will  not  yield  under  normal  working  conditions.  In  addition  its  stiffness  must 
be  low  enough  to  exhibit  flexibility  at  these  loads.  As  will  be  seen  in  this  section,  it 
is  difficult  to  design  a  spring  which  has  at  the  same  time  a  high  yield  strength  and 
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low  stiffness.  The  design  targets  for  the  spring  were  4Nm  maximum  torque,  with  an 
angle  of  twist  of  about  5  degrees. 

The  design  of  the  spring  also  motivated  the  mechanical  layout  of  the  actuator. 
It  was  felt  that  a  simple  actuator  would  be  best  to  build  at  first,  and  so  cables  and 
tendons  were  avoided.  The  design  chosen  is  illustrated  in  Figure  5-2.  A  torsional 
spring  is  used  as  the  elastic  element,  mounted  between  the  motor  shaft  and  the 
actuator  output.  The  output  runs  in  a  bearing,  the  spring  passing  through  the  centre 
of  the  axle  to  save  space.  The  gearbox  has  bearings  which  support  the  other  end  of 
the  spring.  Arranging  the  spring  like  this  allows  a  compact  design,  but  puts  a  limit 
on  the  maximum  diameter  of  the  spring  of  about  0.9”  (23mm),  due  to  the  availability 
of  bearings.  The  maximum  length  of  the  spring  was  set  to  3”  (76.2mm)  to  further 
ensure  the  compactness  of  the  design. 


Encoder 


Figure  5-2:  Schematic  of  mechanical  design 


The  most  obvious  type  of  torsional  spring  is  a  cylinder.  For  a  cylinder  with  length 
/,  diameter  d,  the  formula  for  the  maximum  shear  stress  under  torsion  is  [27] 

16TAa37  /p:  1  \ 

'^max  \  *■^2 

Where  Tmax  is  the  maximum  force.  This  can  be  rearranged  to  show  that  the  minimum 
diameter  for  the  rod  is  _ 

,  ,/32T'maa;  /cr  r>\ 


drain  — 


^  ^yield 


using  Tresca’s  yield  criterion,  that  yielding  begins  when  Tmax  is  equal  to  half  of  the 
yield  stress,  cryieid-  The  expression  for  the  angle  of  twist  of  the  rod  at  yield,  the 
minimum  length  of  the  rod  (given  that  angle),  and  the  resulting  stiffness  of  the  spring 
are  given  below,  where  G  is  the  shear  modulus. 


^yield  — 


32Tmaxl 

ird'^G 
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^min 
k spring 

The  table  below  show  parameters  for  springs  of  this  type  made  from  a  number  of 
different  materials,  for  the  design  condition  Tmax  =  4Nm,  6yieid  =  5  degrees. 


Material 

E  kN/mm^ 

G  kN/mm^ 

o-yieid  N/mm^ 

dmin  mm 

Imin  mm 

Steel 

210 

81 

240 

5.54 

163.4 

Aluminium 

70 

27 

200 

5.88 

69.1 

Delrin 

3.6 

1.4 

69 

8.39 

14.9 

Nylon  66 

3.3 

1.27 

81.6 

7.93 

10.75 

Table  5.2:  Torsional  spring  Characteristics 


Of  the  materials  in  the  table,  steel  is  probably  the  most  approj^riate,  as  it  has  a 
definite  yield  point.  Most  commercially  available  springs  are  made  from  steel  (spring 
steel).  However,  in  this  configuration  the  use  of  steel  is  rather  impractical.  Alu¬ 
minium  is  more  practical,  but  it  does  not  have  a  definite  yield  point.  The  plastics 
are  also  promising,  but  they  have  a  stock  of  undesirable  properties,  such  as  creep, 
hysteresis  and  temperature  effects,  in  addition  to  the  mechanical  problems  associated 
with  gripping  them. 

The  problem  with  cylindrical  springs  is  that  they  are  too  efficient  in  torsion — if 
they  are  designed  so  that  they  will  not  yield,  they  are  too  stiff.  Other  possible  sections 
were  considered  were  tubes  and  square  sections,  which  were  also  too  efficient,  and  fiat 
plates  which  were  more  promising. 

The  equations  which  define  the  torsional  behaviour  for  a  flat  plate  (such  as  in 
Figure  5-5  (b)),  with  length  /,  width  b  and  thickness  t  are  given  below  [5] 


TTclmin^Gd 


yield 


^ dm.in.  G 


32/ 


(5.4) 

(5.5) 


'^max 


T  = 


k 


spring 


^maxGO 

^min 

he  hh 

q  max  1 
^  l^min 

V  • 


(5.6) 

(5.7) 

(5.8) 


Equation  5.6  shows  that  the  yield  angle  is  determined  by  the  ratio  tmaxl^min  and  is 
independent  of  the  width  b.  The  stiffness  of  the  spring  (and  the  maximum  torque) 
follow  from  the  choice  of  the  width.  This  is  good  as  the  spring  yield  angle  and  the 
stiffness  can  be  designed  separately.  The  table  below  shows  designs  for  a  flat  plate 
spring  with  length  3”  (76.2mm). 

The  values  for  b  are  large,  especially  for  steel  which  would  make  the  use  of  this  type 
of  spring  difficult  in  practice.  However,  if  the  plate  is  cut  into  strips,  and  arranged  as 
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Material 

E  kN/mm^ 

G'kN/mnT 

ayieid  N/mm^ 

Ijt 

t„,in  mm 

^TOrnmni 

Steel 

210 

240 

58.9 

1.29 

60.4 

Aluminium 

70 

27 

200 

23.6 

3.23 

11.5 

Table  5.3:  Results  for  plate  spring 


shown  in  Figure  5-3,  then  the  wide  sheet  can  be  packed  into  a  compact  spring.  As  the 
yield  angle  is  determined  by  t  and  /,  the  stiffness  can  be  altered  by  simply  adjusting 
the  width  and  the  number  of  strips.  The  equations  will  no  longer  hold  precisely  as 
not  all  the  strips  pass  through  the  axis  of  twist. 


Figure  5-3:  Composite  spring  drawing 

A  spring  of  this  design  was  built  out  of  strips  of  shim  steel  (hardened  steel) 
fastened  with  clamps.  A  good  design  was  used  6  strips,  of  width  0.55”  (14mm), 
length  1.9”  (48.3mm),  and  thickness  0.032”  (0.81mm).  0.01”  (0.25mm)  spacers  were 
placed  between  the  sheets  to  prevent  them  rubbing  against  each  other.  The  spring 
was  found  to  work  reasonably  well,  the  force  being  roughly  linear  with  the  twist  angle, 
with  a  small  amount  of  hysteresis,  as  shown  in  Figure  5-4.  The  spring  was  quite  a  lot 
stiffer  than  predicted  (40.1  Nm/rad  as  opposed  to  25.1  Nm/rad)  which  is  probably 
a  consequence  of  the  outermost  spring  layers  being  in  a  combination  of  tension  and 
torsion,  rather  than  pure  torsion.  Early  experiments  were  carried  out  performing 
torque  control  using  a  spring  of  this  design. 

The  composite  spring  was  difficult  to  manufacture,  assemble  and  maintain,  the 
main  problem  being  fastening  the  strips  securely.  It  was  also  lossy  due  to  the  hystere¬ 
sis,  so  a  better  one  piece  spring  was  devised.  By  selecting  a  cross  shape,  more  strips 
could  be  put  in  pure  torsion,  as  shown  in  Figure  5-5  (a).  A  photograph  of  a  typical 
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Data  for  composite  spring 


Figure  5-4:  Results  for  bar  spring  (6  strips) 


spring  is  included  in  Figure  5-6. 


Figure  5-5:  Cross  Spring  Drawing 


It  was  not  obvious  how  to  relate  the  torsional  behaviour  of  this  type  of  spring 
to  the  flat  plate,  so  a  number  of  springs  were  machined  and  their  performance  was 
compared  to  that  of  a  flat  plate  of  equivalent  dimensions  (see  Figure  5-5).  The 
springs  had  different  web  thicknesses  (it),  lengths  (/),  spring  sizes  (6,  h),  and  were 
manufactured  from  either  aluminium,  or  pre-hardened  steel  (AISI/SAE  4142).  The 
yield  angle,  maximum  torque  and  stiffness  was  evaluated  for  each  of  the  springs.  The 
flat  plate  behaviour  was  calculated  using  the  equations  below,  which  are  taken  from 
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Figure  5-6:  Cross  spring  photograph 


equations  5.6  and  5.8. 


e 


max 


k 


spring 


T 

-L  rr 


I  Trr 


tG 

{bVh)EG 

3/ 


(5.9) 

(5.10) 

(5.11) 


Figure  5-7  shows  a  comparison  between  the  stiffness  of  the  cross  spring  and  the  flat 
plate.  The  relationship  is  a  straight  line  which  shows  that  the  cross  spring’s  behaviour 
obeys  the  same  general  rules  as  the  flat  plate.  There  is  a  scaling  difference;  if  the 
cross  spring  behaved  in  exactly  the  same  way  as  an  equivalent  flat  plate  the  gradient 
of  the  line  would  be  1.0,  while  it  is  actually  0.8.  This  means  that  the  cross  spring 
section  is  inherently  less  stiff  than  the  flat  plate. 

This  is  quite  surprising  given  that  the  joint  between  the  two  webs  would  be  ex¬ 
pected  to  make  the  spring  stiffer.  However  the  spring  material  is  a  lot  nearer  to 
the  twist  axis  in  the  cross  shaped  case  than  for  the  flat  plate,  which  will  reduce  the 
stiffness. 

Figure  5-8  shows  a  similar  comparison  for  the  maximum  angle  of  twist.  Again 
the  results  support  the  conclusion  that  the  cross  spring  is  behaving  the  same  as  the 
flat  plate  with  a  scaling  factor  difference.  This  time  the  maximum  angle  of  twist 
is  greater  for  the  cross  spring,  the  factor  being  around  1.76.  The  reasons  for  this 
difference  are  unclear,  especially  since  the  theory  suggests  that  the  maximum  twist 
angle  is  independent  of  the  width  b,  so  the  proximity  of  the  webs  to  the  axis  should 
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Figure  5-7:  Comparison  of  cross  spring  stiffness 


make  no  difference  to  the  yield  angle. 

The  stiffness  and  the  maximum  angle  determine  the  maximum  torque  that  can 
be  carried  by  the  spring.  Figure  5-9  shows  clearly  the  advantage  of  the  cross  shape. 
Although  the  stiffness  of  the  section  is  less  than  predicted,  the  increased  angle  of  twist 
outweighs  that  and  makes  the  maximum  torque  about  1.6  times  as  high  as  for  the 
flat  plate.  The  increased  torque  together  with  the  compact  design  makes  this  type  of 
spring  most  suitable  for  use  in  the  actuator. 


.3.  SPRING  DESIGN  AND  DEVELOPMENT 


Figure  5-8;  Comparison  of  cross  spring  angle 


Calculated  maximum  torque  Nm 


Figure  5-9:  Comparison  of  cross  spring  torque 
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5.4  Actuator  Spring  Design 

The  final  spring  chosen  for  the  actuator  had  a  web  thickness  of  0.05”  (1.3mm),  the 
spring  dimensions  were  0.5”  (12.7mm)  by  0.85”  (21.6mm),  and  the  length  was  2.4” 
(61mm). 

Figure  5-10  shows  the  result  of  a  test  of  the  stiffness  of  this  spring,  using  the 
encoder  on  the  motor  to  measure  the  angle  of  twist.  The  kink  in  the  middle  is  due 
to  the  backlash  of  the  motor.  The  stiffness  is  slightly  different  in  different  directions 
of  twist,  being  46.3  Nm/rad  in  one  direction  and  45.0Nm/rad  in  the  other  direction. 
In  a  different  test  the  maximum  angle  of  twist  before  yielding  was  found  to  be  7.4 
degrees  or  0.129  rad. 


Spring  Characteristics 


Figure  5-10:  Plot  of  spring  torque  against  spring  angle 


5.5  Force  sensor  selection 

As  well  as  providing  elasticity  the  spring  also  acts  as  a  force  sensor,  allowing  the 
actuator  output  force  to  be  controlled.  As  the  spring  is  linear,  a  measurement  of  the 
angle  of  twist  will  also  give  the  force.  This  measurement  is  difficult  in  this  case  since 
the  angle  is  small  (generally  less  than  5  degrees).  The  next  two  sections  describe 
sensors  which  were  used  to  measure  the  angle  and  the  force. 

5.5.1  Sensor  1  :  Potentiometer 

There  are  essentially  two  ways  to  measure  the  twist  in  the  spring,  firstly  by  mea¬ 
suring  the  angle  of  both  ends  and  subtracting  the  results  ,  and  secondly  to  measure 
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the  angle  directly.  The  latter  method  was  chosen  as  it  offered  a  less  complex  imple¬ 
mentation  requiring  fewer  sensors,  less  calibration,  and  potentially  greater  accuracy 
due  to  increased  resolution.  A  potentiometer  was  used,  the  shaft  being  connected  to 
the  actuator  output,  and  the  body  connected  to  the  output  of  the  motor  with  a  stiff 
support.  This  is  shown  in  Figure  5-11. 


Encoder 


Bearing 

Pot  support 

h 


Potentiometer 


Motor  and 
Gearbox 


r 


Actuator 

output 


Figure  5-11:  Schematic  of  potentiometer  attachment 

The  potentiometer  used  was  a  lOkfi  Spectrol  Model  140  precision  type.  The 
signal  from  this  was  sampled  by  the  control  circuit  (see  section  5.7),  and  was  also 
differentiated  using  an  analogue  circuit. 

This  sensor  worked  surprisingly  well  but  had  a  number  of  problems.  Firstly  the 
signal  was  noisy  (and  so  its  differential  was  even  more  noisy)  due  to  the  action  of 
the  wiper  moving  over  the  resistive  element.  As  the  angle  measured  was  small  high 
gains  were  needed  to  amplify  the  signal,  which  also  amplified  the  noise.  Secondly  it 
was  felt  that  the  steel  strip  that  held  the  body  of  the  pot  might  flex  and  twist  as  the 
angle  changed,  making  the  results  inaccurate.  The  sensor  was  difficult  to  assemble, 
and  had  to  be  set  up  very  carefully,  all  of  which  was  lost  when  the  system  was 
disassembled.  It  was  also  bulky,  which  was  undesirable  from  the  mechanical  design 
point  of  view.  A  one  piece  sensor  was  developed  to  overcome  some  of  these  problems, 
which  is  described  in  the  following  section. 

5.5.2  Sensor  2  :  Strain  Gauges 

This  sensor  measures  the  force  by  looking  at  the  strain  developed  on  the  spring  webs 
while  it  is  twisted.  It  was  assumed  that  the  strain  would  vary  linearly  with  the 
load,  which  was  confirmed  by  experiment  (discussed  later  in  this  section).  The  cross 
shaped  spring  described  in  the  previous  section,  and  illustrated  in  Figure  5-5  lent 
itself  to  instrumentation  in  this  way,  the  gauges  being  easily  mounted  on  the  flats 
of  the  spring.  A  full  bridge  can  be  made  by  putting  2  gauges  on  opposite  sides  of 
the  web,  as  illustrated  in  Figure  5-12.  The  gauges  are  aligned  with  the  direction  of 
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maximum  stress,  which  is  at  45  degrees  to  the  axis  of  twist  for  torsion.  Figure  5-13 
shows  a  closeui?  of  the  actuator  and  spring.  The  strain  gauges  are  not  quite  visible, 
but  are  mounted  just  where  the  spring  goes  into  the  axle  tube. 


Spring 


Figure  5-12:  Showing  position  of  gauges  on  the  spring 


Figure  5-13:  Closeup  of  spring 


The  gauges  used  were  Micro  Measurements  CEA-06-062UV-350[33].  An  Analog 
Devices  1B31AN  Strain  Gauge  Conditioner  was  used  to  measure,  amplify  and  filter 
the  signal  from  the  gauges,  which  was  then  differentiated  and  sampled  for  control 
purposes  (see  section  5.7). 
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The  signals  from  the  strain  gauges  were  considerably  less  noisy  than  the  poten¬ 
tiometer  signals  (once  they  had  been  shielded  correctly).  The  gain  and  offset  of  the 
amplifier  is  easily  adjusted,  so  calibration  of  the  sensor  is  easy.  A  plot  of  the  re¬ 
lationship  between  the  potentiometer  and  the  strain  gauge  readings  is  included  in 
Figure  5-14  below.  The  “staircase”  like  shape  of  this  plot  probably  results  from  the 
movement  of  the  pot  shaft  holder. 

Comparison  of  potentiometer  and  strain  gauge  sensors 


Figure  5-14:  Plot  of  strain  gauge  reading  versus  potentiometer  reading 

Figure  5-15  shows  a  plot  of  the  strain  gauge  reading  versus  actual  torque,  measured 
using  a  spring.  The  ratio  between  strain  gauge  reading  and  actual  torque  is  20. 

Strain  gauges  are  notorious  for  being  difhcult  to  use  in  noisy  environments  (for 
example  near  large  motors  using  PWM^).  This  problem  is  present  in  this  application 
but  is  helped  somewhat  by  the  fact  that  the  angle  of  twist,  and  so  the  strains  being 
measured  are  large  compared  to  normal  strain  gauge  applications,  so  the  gain  of  the 
amplifier  can  be  small.  On  the  other  hand,  the  noise  is  increased  when  the  signal  is 
differentiated  (see  section  5.7).  Careful  shielding  of  the  system  reduced  the  noise  to 
a  tolerable  level. 


^  Pulse  Width  Modulated  (PWM)  is  a  common  technique  for  driving  DC  brushed  electric  motors 
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Figure  5-15:  Plot  of  strain  reading  versus  measured  torque 


5.6  Electronic  Setup 

This  section  describes  the  electronics  and  control  hardware  that  was  used  to  imple¬ 
ment  the  torque  control.  A  schematic  of  the  whole  system  is  shown  in  Figure  5-16. 
The  strain  gauges  are  connected  to  a  sensor  board,  where  their  signal  is  amplihed, 
filtered  and  differentiated,  before  being  passed  to  the  motor  board.  The  cut  off  fre¬ 
quency  of  the  strain  gauge  amplifier  is  2kHz,  and  of  the  differentiator  lOOHz.  These 
values  were  selected  to  ensure  that  there  was  not  significant  phase  roll  over  the  work¬ 
ing  frequency  of  the  actuator  (which  is  0  to  20Hz). 


Figure  5-16:  The  complete  system  block  diagram 
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The  motor  board  contains  a  Motorola  6811  micro-controller,  on  which  the  control 
code  runs.  The  6811  has  4  analogue  to  digital  converters,  which  are  used  to  sample 
the  sensor  readings.  The  control  loop  is  set  to  run  at  IkHz.  The  board  also  contains 
hardware  to  read  the  encoder  on  the  motor,  a  PWM  generating  circuit,  and  a  H 
bridge  to  provide  power  to  the  motor.  There  is  a  differentially  driven  communication 
bus  to  the  Motorola  68332  processor.  Code  for  the  6811  is  hand  coded  in  assembly 
language,  and  then  down-loaded  from  the  serial  line  of  the  Macintosh  PC.  The  motor 
board  essentially  contains  all  that  is  need  to  control  the  motor. 

The  68332  is  used  for  higher  level  processing.  It  communicates  with  the  motor 
board  at  up  to  400Hz,  sending  gains  and  set-points  for  the  control  loop,  and  receiving 
data.  The  processor  runs  L,  a  subset  of  Common  Lisp,  written  by  Rodney  Brooks 
at  MIT  [6].  The  front  end  of  the  68332  is  a  Macintosh  PC,  where  the  data  from  the 
actuator  can  be  displayed  and  analysed. 
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5.7  Control 

The  control  loop  implemented  on  the  6811  is  similar  to  that  detailed  in  Chapter 
3.  A  block  diagram  showing  all  the  systems  is  included  in  Figure  5-17..  There  are 
essentially  five  parts  in  the  diagram,  the  sensor  differentiation  part,  the  PID  servo 
on  desired  torque,  the  feedforward  terms  for  desired  torque  and  acceleration  of  the 
output  shaft,  and  the  feedforward  model  of  the  motor. 

Some  comments  about  the  block  diagram: 

•  The  A/D  converter  on  the  6811  is  only  8  bits,  so  in  order  to  reduce  the  errors 
from  differentiating  small  signals  in  software,  the  analogue  sensor  readings  were 
differentiated  using  an  analogue  circuit.  The  encoder  reading  is  16  bits,  and 
changes  enough  in  normal  use  to  allow  differentiation  in  software.  To  help  this, 
the  effective  sampling  frequency  for  the  encoder  was  reduced  to  250Hz. 

•  The  feedforward  model  described  in  section  3.3  was  implemented  apart  from 
the  term  which  included  the  second  differential  of  the  desired  force.  This  was 
because  of  the  difficulties  of  differentiating  small  fixed  numbers  in  software.  The 
encoder  velocity  was  calculated  by  differencing  the  encoder  readings.  This  was 
used  with  the  differentiated  strain  gauge  signal  to  calculate  the  acceleration  of 
the  output  shaft  6i.  The  parameter  “Fgain”  is  a  gain  parameter  corresponding 
to  the  amount  of  feedforward  used  (Kff  in  figure  3-5). 

•  The  readings  for  the  strain  gauges  were  converted  to  16  bits  for  the  servo  loop 
calculations,  and  16  bit  gains  were  used.  The  output  of  the  servo  loop  is  a  desired 
current,  an  8  bit  number.  This  is  the  input  to  the  feedforward  motor  model, 
which  produces  a  PWM  duty  cycle  command  (8  bits)  and  a  direction  (1  bit) 
which  are  applied  to  the  motor.  The  6811  carries  out  fixed  point  arithmetic, 
which  is  why  there  are  so  many  “divide  by  256”  terms  in  the  block  diagram. 

•  The  motor  is  driven  by  an  H-bridge,  using  PWM  at  48V,  and  31.25kHz.  A 
simple  feedforward  model  of  the  motor  was  used  to  calculate  the  correct  voltage 
to  apply  to  ensure  that  the  motor  current  (and  so  the  torque)  followed  that 
commanded  by  the  control  system.  The  6811  was  not  fast  enough  to  run  a 
separate  current  feedback  loop  as  well  as  the  torque  control.  A  full  feedforward 
model  would  include  terms  to  compensate  for  the  motor  resistance,  inductance 
and  back  emf  (see  Figure  5-18),  however  only  terms  for  the  resistance  and  the 
back  emf  were  implemented. 


MOTOR  MODEL 


5.7.  CONTROL 
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Figure  5-18:  Motor  model 

5.8  Test  Rig 

As  described  in  Chapter  4,  a  good  test  of  the  actuators  performance  is  a  measure 
of  the  range  of  output  impedances  that  it  can  produce.  To  do  this,  a  test  rig  was 
devised  that  allowed  the  position  of  the  actuator  shaft  to  be  moved  in  a  controlled 
fashion,  independently  of  the  torque  output  of  the  actuator.  A  photograph  of  the 
setup  is  shown  in  Figure  5-19^.  The  torque  controlled  actuator  is  on  the  right,  and 
the  position  controlled  one  on  the  left.  It  consists  of  the  usual  torque  controlled 
actuator,  with  the  end  being  driven  by  a  RH- 14-6002  (24V,  20W)  motor,  with  a 
harmonic  drive  gearbox.  This  was  chosen  mainly  because  it  was  available,  and  the 
gearbox  had  minimal  backlash.  The  control  setup  for  this  motor  is  identical  to  that  of 
the  torque  controlled  one,  except  that  it  servos  to  a  position  measured  by  its  encoder. 


Figure  5-19:  Photograph  of  the  Actuator  test  rig 


^The  position  controlled  actuator  illustrated  is  not  the  one  referred  to  in  the  text,  although  the 
setup  is  the  same 


Chapter  6 

Experimental  Results 


6.1  Introduction 

This  chapter  describes  the  experimental  data  taken  from  the  series  elastic  actuator 
described  in  chapter  5.  The  identification  of  the  system  is  described,  and  the  measured 
frequency  response  of  both  open  and  closed  loop  systems  are  included. 

The  calculations  made  to  determine  the  frequency  responses  assume  that  the 
system  is  linear,  while  the  actual  system  is  affected  to  some  extent  by  non-linearities 
such  as  friction,  backlash  and  saturation.  The  plots  are  included  as  they  represent 
how  the  system  behaves  in  a  compact  format.  An  attempt  was  made  to  collect  data 
in  regions  where  the  non-linear  effects  were  not  large,  to  improve  accuracy. 

The  overall  performance  limits  of  the  system  were  tested  on  a  frequency  by  fre¬ 
quency,  amplitude  by  amplitude  basis,  so  as  to  capture  the  non-linear  effects.  Com¬ 
parisons  are  drawn  between  the  theoretical  predictions  and  the  actual  experimental 
data. 


6.2  System  Identification 

The  system  was  identified  using  a  sweep  sine  technique.  Time  domain  data  of  the 
actuators  behaviour  was  analysed  using  a  simple  single  frequency  Fourier  transform, 
to  capture  the  magnitudes  and  phases  of  the  relevant  signals.  The  esoteric  nature  of 
the  control  hardware  used  for  the  actuator  made  the  use  of  a  commercially  available 
spectrum  analyser  difficult.  The  major  drawback  of  the  homemade  system  was  that 
some  of  the  calculations  were  carried  out  in  fixed  point  arithmetic,  causing  rounding 
errors,  especially  when  the  system  was  trying  to  measure  small  signals. 

The  transfer  functions  between  the  motor  current  and  the  output  force  with  the 
actuator  output  shaft  clamped,  and  also  between  the  output  force  and  the  motion 
of  the  output  shaft  were  identified.  The  latter  function  is  the  output  impedance  of 
the  actuator.  Matlab  was  then  used  to  fit  a  simple  transfer  function  model  to  the 
experimental  data.  Figures  6-1  and  6-2  show  the  experimental  results  together  with 
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the  fitted  model  responses. 


Comparison  of  data  and  the  model 


Figure  6-1:  Bode  plot  for  force  transfer  function 


Comparison  of  data  and  the  model 


Frequency  rad/sec 


Figure  6-2:  Bode  plot  for  impedance  transfer  function 


The  data  for  the  force  transfer  function  shows  a  lower  gain  than  expected  at  low 
frequencies  as  well  as  a  significant  phase  lag,  which  is  probably  attributable  to  the 
effects  of  stiction  in  the  bearings.  It  was  noticed  that  the  sine  waveforms  for  current 
were  actually  clipped  at  these  frequencies.  The  shape  of  the  bode  plot  is  characteristic 
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of  a  lightly  damped  second  order  system.  The  identified  model  is  given  below. 

IL(^s)  =  - - - -  (6.1) 

Tm  +  7.895  +  1475  ^  ^ 

The  poles  are  at  —3.945  ±  38.2026j,  they  have  natural  frequency  of  38.406  rad/sec, 
and  damping  factor  (  =  0.1027.  The  theoretical  transfer  function  is  rewritten  below 


Tl  ,  _  _ 1 _  _  ksj Jm 

Tm  "  \-\-S^Jmlks  S^-\-kslJm 


(6.2) 


The  quoted  value  for  the  motor  inertia  is  0.02Kgm^,  and  the  measured  value  of 
the  spring  constant  is  46  Nm/rad  (see  chapter  5),  which  corresponds  to  a  natural 
frequency  of  48.0  rad/sec.  The  measured  natural  frequency  corresponds  to  a  motor 
inertia  of  0.03  Kgm^,  which  is  higher  than  the  quoted  value  of  0.02Kgm^.  This  is 
not  surprising  since  the  quoted  inertia  does  not  include  the  inertias  of  the  gearbox 
and  the  spring.  The  denominator  of  the  identified  transfer  function  above  (59)  does 
not  compare  well  to  the  value  for  ksj  Jm  which  is  1475.  This  is  because  the  transfer 
function  related  motor  current  rather  than  motor  force  to  output  force.  Once  the 
correct  scaling  factor  is  used  the  denominator  becomes  1494,  which  is  close  to  1475. 

The  results  of  the  impedance  identification  (Figure  6-2),  also  show  a  second  order 
system  with  under-damped  poles.  The  identified  transfer  function  is  given  by 


T 

0i 


is) 


-Us^ 

52  -f  9.25s  -f  1306 


(6.3) 


compared  to  the  predicted  transfer  function 


r,  -S^Jm  ^  -S^ks 

e,  1  +  s"  +  k,ij„ 


(6.4) 


The  poles  of  the  identified  system  are  at  — 4.625±35.84j,  at  36.14  rad/sec  and  with 
a  damping  factor  of  0.1280.  This  is  slightly  different  than  above,  which  is  probably 
due  to  experimental  error,  and  could  also  be  due  to  frictional  effects  in  the  bearings 
which  are  more  noticeable  when  the  output  shaft  is  moving.  The  denominator  of 
the  transfer  function  (— 44s^)  implies  that  the  spring  constant  is  44  Nm/rad  which 
compares  favourably  with  the  measured  value  of  46  Nm/rad. 

The  identified  transfer  functions  give  useful  information  about  the  system,  and 
will  be  used  to  tune  the  control  loop. 
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6.3  Feedback  Tuning  and  Performance  -  Theoret¬ 
ical 


Figure  6-3:  The  closed  loop  system 

The  full  closed  loop  system  is  illustrated  in  Figure  5-17,  a  more  condensed  version 
being  included  in  figure  6-3.  As  discussed  previously  (sections  3.4  and  5.7),  the  control 
action  consists  of  two  feedforward  terms  and  a  PID  servo  on  the  desired  torque.  Root 
locus  techniques  were  used  to  select  appropriate  values  for  the  gains  in  the  system, 
making  the  system  performance  fast,  with  reasonable  damping,  while  ensuring  that 
the  gains  were  not  set  so  high  as  to  make  the  noise  in  the  system  intolerable.  The 
Kff  gain  was  selected  by  trial  and  error  as  described  in  section  6.5.  The  gains  and 
the  position  of  the  integral  gain  pole  are  given  in  table  6.1  below. 


Gain 

Value 

Pgain 

1908 

Igain 

977 

Vgain 

362 

T 

11.86 

Table  6.1:  Gains  for  closed  loop  system 
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Pole  position 

Damping 

Frequency  (rad/sec) 

-3.8450  H-38.2128i 

0.1001 

38.4057 

-3.8450  -38.2128i 

0.1001 

38.4057 

-65.7259  -f75.5188i 

0.6565 

100.1148 

-65.7259  -l-75.5188i 

0.6565 

100.1148 

-13.9036 

1.0000 

13.9036 

Table  6.2:  Closed  loop  poles 


Table  6.2  shows  the  expected  location  of  the  closed  loop  poles  of  the  system  when 
these  gains  are  applied.  Figures  6-4  and  6-5  show  the  effect  of  closing  the  feedback 
loop,  the  natural  frequency  of  the  system  changing  to  about  38  rad/sec,  and  the  size 
of  the  resonant  peak  being  reduced.  The  impedance  of  the  output  is  also  lower  at  low 
frequencies,  and  remaining  the  same  at  high  frecpencies. 


Bode  plot  for  Force  v.  Desired  Force 


Figure  6-4:  Bode  plot  for  simulated  closed  loop  force  transfer  function 


6.4  Feedback  Tuning  and  Performance  -  Experi¬ 
mental 

The  gains  in  Table  6.1  were  used  in  the  control  system  for  the  actuator.  To  check 
the  performance  of  the  closed  loop,  the  system  was  identified  again,  using  sweep  sine 
as  before.  The  results  of  this  test  are  shown  in  Figure  6-6.  This  plot  shows  the  open 
loop,  the  predicted  closed  loop  and  the  actual  closed  loop  response.  The  closed  loop 
response  is  better  than  the  open  loop,  and  the  pole  due  to  the  resonance  of  the  motor 
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Bode  plot  for  Impedance 


Figure  6-5:  Bode  plot  for  simulated  closed  loop  impedance  transfer  function 


mass  on  the  spring  has  been  effectively  relocated  to  a  higher  frequency. 

However,  the  actual  response  is  quite  different  from  that  predicted  by  the  theory. 
The  response  has  a  higher  gain  than  predicted  at  low  frequencies,  and  there  is  what 
appears  to  be  an  under-damped  pole  at  63  rad/sec.  The  phase  rolls  off  towards  —180 
degrees  which  is  also  unexpected,  although  the  approximate  gradient  of  the  phase 
roll  is  the  same  as  that  predicted  by  the  simulation.  To  determine  whether  this  extra 
“pole”  was  caused  by  non-linear  effects  such  as  backlash  or  saturation,  the  test  was 
conducted  again,  with  a  bias  on  the  desired  torque.  It  was  difficult  to  completely 
eliminate  the  backlash  by  this  method,  but  its  effect  was  reduced  significantly  over 
all  frequencies,  especially  so  for  low  frequencies.  Small  torques  had  to  be  used  to 
obtain  this,  which  made  the  calculation  less  accurate  due  to  rounding  errors,  but  a 
general  trend  can  be  seen  in  Figure  6-7.  The  biased  runs  follow  the  simulated  closed 
loop  behaviour  much  more  closely  than  the  run  where  the  backlash  was  significant. 
The  peak  in  their  bode  plots  also  seems  to  fall  near  where  the  predicted  maximum 
should  be.  The  phase  plot  is  also  interesting,  as  the  jump  in  phase  is  reduced  in 
size  when  the  backlash  is  reduced.  The  gradient  of  the  phase  roll  is  similar  to  that 
predicted  by  the  simulation.  All  of  this  suggests  that  the  backlash  is  a  contributory 
factor  in  the  “pole”  at  63  rad/sec. 

The  backlash  is  like  a  dead  band  where  the  motor  mass  can  accelerate  without 
contacting  the  spring.  It  is  possible  that  this  non-linearity  can  lead  to  oscillation 
(see  Khalil  [20]),  with  a  precise  resonant  frequency,  dependent  on  the  size  of  the  non¬ 
linearity,  and  the  characteristics  of  the  rest  of  the  system.  This  would  also  explain 
why  this  effect  is  only  observed  when  the  feedback  loop  is  closed. 

Figure  6-8  shows  the  results  for  the  closed  loop  impedance.  Again  the  closed  loop 
system  is  considerably  better  than  the  open  loop,  the  impedance  being  reduced  for 
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Closed  and  open  loop  behaviour 


Figure  6-6:  Bode  plot  for  identified  closed  loop  force  transfer  function 


Closed  and  open  loop  behaviour 


Frequency  rad/sec 


Figure  6-7:  Bode  plot  of  the  dependence  of  the  system  closed  loop  response  of  backlash 
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Closed  and  open  loop  behaviour 


Figure  6-8:  Bode  plot  for  identified  closed  loop  impedance  transfer  function 


all  frequencies  less  than  about  60rad/sec.  It  should  be  noted  that  the  method  used  to 
obtain  the  magnitudes  and  phases  is  less  accurate  for  small  gains,  so  the  phase  plots 
for  small  frequencies  are  inaccurate.  Again  the  actual  response  but  is  not  very  similar 
to  that  predicted  by  the  theory.  The  under-damped  response  is  clear  here,  although 
it  happens  at  a  lower  frequency  (about  8Hz  or  50rad/sec).  It  was  hoped  to  eliminate 
the  effects  of  backlash  for  this  test,  however  the  position  motion  required  to  ensure 
that  the  motors  force  always  remained  positive  was  so  small  that  no  useful  data  could 
be  collected.  The  high  frequency  impedance  corresponds  to  a  spring  constant  to  of 
about  58  Nm/rad. 


6.5  Assessing  the  effect  of  the  Kff  gain 

From  looking  at  the  control  system  in  figure  6-3,  The  open  loop  transfer  function 
between  force  output  and  the  motion  of  the  output  shaft  including  the  feedforward 
term  is  given  by 

Ii(  )  ^  ^  -s^Ul-Kff)  .g  g. 

01^"^  l  +  s^  +  h/J^ 

Kff  reduces  the  effective  stiffness  of  the  spring  to  ks{l—Kfj).  It  is  important  that  Kff 
is  less  than  one  otherwise  non  passive  behaviour  will  result.  To  determine  the  effect 
on  the  real  system  of  changing  Kff,  the  impedance  of  the  system  was  measured  as  it 
was  varied.  The  results  for  both  the  open  loop  and  closed  loop  cases  are  illustrated 
in  Figure  6-9. 
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It  is  clear  from  the  figure  that  increasing  Kff  has  the  desired  effect  of  reducing  the 
output  impedance  at  low  frequencies.  At  high  frequencies  the  system  is  dominated 
by  the  non-linear  effects  of  saturation  and  backlash,  so  the  gain  has  little  obvious 
effect.  The  signal  is  noisy,  and  a  tradeoff  has  to  be  made  between  the  size  of  the  gain 
and  the  actual  overall  system  performance.  For  gains  above  Kff  =  0.31  the  overall 
system  performance  is  degraded.  If  the  gain  is  raised  too  much  the  system  behaviour 
changes,  as  can  be  seen  in  the  case  where  Kff  =  0.54.  The  value  Kff  =  0.27  was 
selected  as  giving  the  best  tradeoff  between  performance  and  noise. 


Open  loop  Closed  loop 


Figure  6-9:  Bode  plot  showing  effect  of  Kff 


6.6  System  Performance 

Figure  6-10  shows  the  bode  plots  for  the  system  performance  with  the  final  gains  and 
feedforward  terms.  Both  the  open  and  closed  loop  responses  are  included. 


System  Force  Control 


System  Impedance 


Frequency  rad/sec 


Figure  6-10:  Bode  plot  showing  performance  of  system 
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The  system  torque  control  performance  while  in  contact  with  a  hard  (Aluminium) 
and  a  sort  (rubber)  surface  was  also  measured.  Figure  6-11  shows  the  response  to 
a  square  wave  in  commanded  torque.  The  response  for  the  soft  surface  is  slightly 
less  damped  than  for  the  hard  one,  but  neither  exhibits  the  instability  common  in 
this  type  of  test  (see  An  [2]).  Figure  6-12  shows  a  similar  test  where  the  torque 
is  commanded  to  follow  a  sine  wave  command.  Again  the  performance  is  good  in 
both  cases.  Figure  6-13  shows  the  force  control  performance  at  following  a  sine  wave 
command  when  the  output  shaft  of  the  actuator  is  also  being  moved.  Performance 
in  this  kind  of  test  is  covered  in  more  detail  in  the  following  section. 


Force  response  for  contact  with  a  hard  surface 


1 

- - Goa!  torque: 

:  :  1 

■: —  Actual  torque 

_i _ i_ 


Force  response  for  contact  with  a  soft  surface 


-  Goal  torque 

-  Actual  torque 


0.1  0.2  0.3  0.4  0.5  0.6  0.7  0.8 

Time  in  seconds 


0.9  1  0  0. 
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Time  in  seconds 


Figure  6-11:  Square  wave  response 


Force  response  for  contact  with  a  hard  surface  Force  response  for  contact  with  a  soft  surface 


Figure  6-12:  Sine  wave  response 
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Force  response  when  the  output  is  moving 


Figure  6-13:  Torque  control  performance  when  the  output  shaft  is  moving 

6.7  Performance  Limits 

The  final  series  of  tests  which  were  carried  out  were  to  evaluate  the  performance  of 
the  actuator  over  a  range  of  frequencies  while  attempting  to  provide  force  at  a  defined 
impedance.  This  can  be  directly  compared  to  the  results  from  chapter  4. 

The  actuator  was  commanded  to  follow  a  sinusoidal  force  waveform,  while  its 
output  shaft  was  moved  at  the  same  frequency,  with  a  constant  phase  difference 
between  the  force  command  and  the  position  waveform,  so  defining  the  impedance 
output  of  the  system.  The  sizes  and  phases  of  the  signals  were  varied  to  test  over  a 
range  of  impedances.  Figure  6-13  shows  a  sample  test  condition.  The  error  in  the 
force  tracking  was  measured  and  used  to  determine  the  maximum  force  that  could 
be  tracked  with  a  defined  error,  at  a  certain  impedance.  The  tester  assumed  that  the 
error  increased  with  the  magnitude  of  the  commanded  force,  and  ramped  the  force 
up  and  down  accordingly.  Due  to  rounding  errors  the  error  was  large  for  both  large 
and  small  forces,  with  a  minimum  condition  in  between.  The  algorithm  was  chosen 
so  that  it  always  selected  the  maximum  force  for  a  given  error  tolerance. 

Due  to  the  limitations  of  the  position  controlled  motor,  the  magnitude  and  phase 
of  the  motion  were  not  always  as  specified  for  the  test  point.  This  made  the  actual 
impedance  tested  different  from  the  desired  impedance  test-point.  The  same  Fourier 
transform  that  was  used  to  calculate  the  frequency  responses  (see  section  6.2)  was  used 
to  determine  the  exact  impedance  of  the  test-point,  and  then  Matlab’s  interpolation 
routines  were  then  used  to  convert  the  irregularly  spaced  data  points  onto  a  square 
grid  so  that  they  could  be  plotted. 

Figure  6-14  shows  the  maximum  force  at  10%  error  for  2Hz,  or  12  rad/sec,  together 
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with  a  plot  of  the  theoretical  results.  The  actuator  performance  is  good  and  is  similar 
to  that  predicted  by  the  saturation  model. 


Maximum  force  at  1 0%  error,  at  12  rad/sec  Frequency  =  12  rad/sec 


Figure  6-14:  Performance  results  for  12  rad/sec 


When  the  frequency  is  increased  to  4Hz,  or  25  rad/sec  (Figure  6-15),  then  there 
is  a  larger  range  of  impedances  where  the  force  control  does  not  work  so  well.  The 
experimental  results  show  an  area  where  the  output  force  is  zero.  This  means  that  the 
tester  could  not  find  a  force  with  10%  error  at  that  impedance,  not  that  the  actuator 
outputs  no  force!  The  size  of  the  hole  is  bigger  than  expected,  which  is  probably  due 
to  inefficiencies  in  the  motor,  backlash  friction,  and  a  whole  host  of  other  non-linear 
effects.  It  is  not  clear  why  the  surface  is  uneven. 


Maximum  force  at  1 0%  error,  at  25  rad/sec  Frequency  =  25  rad/sec 


Figure  6-15:  Performance  results  for  25  rad/sec 
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The  plot  for  GHz  (37.7  racl/sec),  which  roughly  corresponds  to  the  natural  fre¬ 
quency  of  the  system  is  shown  in  Figure  6-16.  The  general  shape  of  the  two  plots  is 
similar — the  actuator  being  unable  to  provide  forces  near  zero  impedance.  The  theory 
suggests  that  the  actuator  can  output  it’s  maximum  force  at  large,  and  the  exper¬ 
imental  results  do  bear  this  out,  although  the  magnitudes  are  lower  in  some  places 
(about  3Nm  as  opposed  to  the  maximum  4Nm).  The  forces  are  lower  for  impedances 
with  a  positive  real  part,  (mass-like  behaviour),  which  is  a  trend  which  continues  as 
the  frequency  is  increased.  The  size  of  the  hole  is  larger  than  predicted  by  the  theory. 


Maximum  force  at  20%  error,  at  37.7  rad/sec  Frequency  =  37.7  rad/sec 


Figure  6-16:  Performance  results  for  37.7  rad/sec 


Maximum  force  at  30%  error,  at  44  rad/sec  Frequency  =  44  rad/sec 


Figure  6-17:  Performance  results  for  44  rad/sec 


When  the  frequency  of  the  test  is  increased  to  7Hz,  or  44  rad/sec,  the  effect  of 
the  spring  becomes  more  clear  (Figure  6-17).  Generally  the  actuator  can  only  output 
forces  for  large  impedances  (that  is  where  the  position  motion  is  small).  However,  for 
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Maximum  force  at  30%  error,  at  44  rad/sec  Current  saturation,  frequency  =  44  rad/sec 


Figure  6-18:  Performance  results  for  44  rad/sec,  including  efBciency 


impedances  which  have  a  negative  real  part — which  are  ones  corresponding  to  spring¬ 
like  behaviour,  the  motor  can  produce  forces  near  its  limit.  Impedances  which  are 
mass  like  (positive  real  part)  are  more  difficult  for  the  actuator.  This  is  the  general 
shape  predicted  by  the  theory,  but  the  effect  is  not  so  pronounced.  One  reason  for 
this  might  be  that  the  motor  is  not  completely  efficient.  A  comparison  between  the 
data,  and  the  performance  of  the  motor  assuming  the  quoted  values  for  the  motor 
and  gearhead  efficiency  (chapter  5,  table  5.1)  is  included  in  Figure  6-18.  The  plot 
taking  into  account  the  efficiency  of  the  motor  matches  the  shape  of  the  data  much 
better. 

It  is  reasonable  to  expect  that  the  efficiency  will  change  with  the  operating  condi¬ 
tions,  as  the  power  losses  overcoming  friction  in  the  system  will  change.  The  friction 
has  two  main  components,  static  friction,  (or  stiction)  which  occurs  when  the  gears 
begin  to  move,  and  dynamic  friction,  caused  by  the  motor  having  to  work  against  the 
frictional  forces  of  the  gearteeth  rubbing  against  each  other,  and  the  commutation 
brushes.  The  dynamic  friction  will  also  have  a  viscous  element,  due  to  the  lubrica¬ 
tion  fluid.  The  static  effects  are  likely  to  dominate  at  low  frequencies,  and  at  higher 
frequencies  and  forces  the  dynamic  friction  will  dominate.  The  dynamic  friction  will 
vary  with  the  load  on  the  motor  (the  frictional  force  is  proportional  to  the  normal 
force),  and  the  power  loss  will  vary  with  frequency  (power  loss  will  be  proportional  to 
the  velocity  of  slipping).  Thus  the  efficiency  of  the  motor  is  expected  to  deteriorate 
for  high  loads  and  high  speeds. 

As  the  frequency  is  increased  above  7Hz,  the  effect  of  the  spring  becomes  more 
pronounced.  In  fact  it  becomes  difficult  for  the  actual  motor  to  produce  any  force  at 
a  mass-like  impedance,  and  it  can  only  produce  forces  when  it  is  acting  like  a  spring. 
Figure  6-19  shows  a  closeup  of  the  spring-like  section  of  the  impedance  plane  for  a  test 
at  8Hz,  along  with  theoretical  data  taking  into  account  the  efficiency  of  the  motor. 
The  rough  shape  is  again  similar,  and  it  almost  looks  as  if  the  motor  is  behaving 
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better  than  expected  in  some  areas.  This  is  most  probably  due  to  a  poor  estimate  of 
the  motor  efficiency. 


Maximum  force  at  30%  error,  at  50.3  rad/sec 


Current  saturation,  frequency  =  50.3  rad/sec 


Figure  6-19:  Performance  results  for  50.3  rad/sec 


Figure  6-20  shows  a  result  for  lOHz.  Here  the  spring  characteristic  is  very  pro¬ 
nounced.  The  size  of  the  peak  is  smaller  too,  only  about  2.7Nm,  as  opposed  to  4Nm 
before.  The  shape  matches  the  theoretical  data  reasonably  well.  The  position  of  the 
peak  corresponds  to  a  negative  real  impedance  of  55  Nm/rad,  which  compares  well 
stiffness  from  the  control  loop  bode  plots  (58  Nm/rad,  see  section  6.4) 


Maximum  force  at  30%  error,  at  62.8  rad/sec  Current  saturation,  frequency  =  62.8  rad/sec 


Figure  6-20:  Performance  results  for  62.8  rad/sec 


A  final  run  at  15Hz  is  included  in  Figure  6-21.  The  actual  performance  is  better 
than  indicated  in  this  plot,  the  results  being  affected  by  limitations  in  the  position 
controlled  motor,  which  could  not  provide  the  position  motion  required  at  this  speed. 
A  small  peak  in  the  plot  can  be  seen,  at  about  50  Nm/rad,  which  corresponds  well 
to  the  measured  spring  stiffness. 
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Maximum  force  at  30%  error,  at  94.3  rad/sec  Current  saturation,  frequency  =  94.3  rad/sec 


Figure  6-21:  Performance  results  for  94.3  rad/sec 


6.8  Summary 

The  performance  of  the  actuator  has  been  determined,  using  both  linear  techniques, 
and  impedance/saturation  representations.  In  the  linear  case  the  backlash  of  the 
motor  was  found  to  affect  the  results.  In  practice  the  high  frequency  commanded 
sinusoid  is  unlikely  to  occur,  so  the  backlash  effect  may  not  be  signihcant.  Its  effect 
is  not  noticeable  in  the  step  and  sine  wave  responses  included  in  this  chapter. 

The  saturation  performance  limits  were  found  to  have  a  similar  shape  to  that 
predicted  by  the  theory,  and  compare  well  if  the  efficiency  of  the  motor  is  taken  into 
account.  The  actuator  behaves  well  at  low  frequencies,  and  the  spring  like  behaviour 
is  very  clear  at  high  frequencies. 


Chapter  7 
Applications 


7.1  Cog 


Series  elastic  actuators  similar  to  that  described  in  this  thesis  are  being  used  for  the 
arms  of  the  humanoid  robot  Cog  [7].  The  robot  will  interact  with  humans  and  perform 
human-like  tasks,  so  it  is  important  that  its  arms  are  safe.  The  arms  must  not  be 
damaged  by  unexpected  collisions,  nor  must  it  damage  its  operator!  The  actuators  are 
being  used  to  give  the  arm  natural  compliance  which  will  aid  it  in  performing  tasks. 
The  actuators  will  also  make  the  arm  stable  while  in  contact  with  all  environments. 
The  shock  load  protection  offered  by  the  actuators  will  also  be  an  advantage,  given 
the  unstructured  environment  in  which  the  arm  will  operate. 

Figure  7-1  shows  a  photograph  of  the  arm  of  the  robot.  It  has  six  degrees  of 
freedom,  two  each  at  the  shoulder  elbow  and  wrist,  all  using  series  elasticity.  A  hand  is 
being  built  by  another  student  (Yoky  Matsuoka).  The  use  of  the  spring  does  introduce 
complexity  into  the  mechanical  design,  and  for  the  wrist  a  cable  transmission  was  Used 
to  tuck  the  motor  out  of  the  way  of  the  hand.  The  arm  is  described  more  thoroughly 
in  [40]. 


7.2  Planetary  rover 


It  is  also  hoped  to  use  the  elastic  actuators  in  an  arm  for  a  planetary  explorer.  The 
arm  will  be  used  to  collect  samples  of  rocks  digging,  collecting  soil  samples  and  other 
exploratory  tasks.  The  contact  nature  of  the  tasks  and  the  unstructured  environment 
make  the  choice  of  series  elastic  actuators  appealing. 

The  arm  for  this  application  is  at  present  in  an  early  design  stage,  but  will  probably 
have  only  four  degrees  of  freedom,  and  a  simple  gripper. 
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Figure  7-1:  Photograph  of  robot  arm 

7.3  Biped  Robot 

Another  group  at  MIT  is  building  a  biped  walking  robot  using  series  elastic  actuators. 
The  design  of  the  actuators  differs  in  that  instead  of  using  a  torsional  spring,  they 
use  tendons  with  ordinary  tension  springs  to  provide  the  elastic  element.  The  contact 
with  the  ground,  and  the  repetitive  motion  associated  with  walking  make  series  elastic 
actuators  good  choices  for  this  application. 


Chapter  8 


Conclusions 


8.1  Review  of  Thesis 

Conventional  robotic  actuators  suffer  from  a  number  of  problems  when  it  comes  to 
providing  good  torque  control.  A  way  to  address  this  problem  has  been  presented 
in  this  thesis.  If  an  elastic  element  is  placed  in  series  with  the  output  of  an  electric 
motor,  the  force  control  performance  of  the  motor  is  improved.  The  motor  is  isolated 
from  shock  loads,  and  the  effects  of  backlash,  torque  ripple  and  friction  are  filtered 
by  the  elastic  element. 

A  further  advantage  is  that  the  actuator  exhibits  stable  behaviour  while  in  contact 
with  all  environments,  a  quality  which  has  been  hard  to  attain  with  a  conventional 
electric  motor  based  actuators.  Along  with  the  benefits  of  elasticity  come  disadvan¬ 
tages  which  include  a  limit  on  the  maximum  force  that  the  actuator  can  output  due 
to  the  mechanical  properties  of  the  elastic  element,  a  reduction  in  the  force  control 
bandwidth  due  to  the  low  pass  nature  of  the  spring,  and  increased  complexity  and 
bulk  in  the  mechanical  design. 

An  trial  actuator  has  been  built  and  tested,  and  some  guidelines  have  been  found 
for  the  design  of  the  spring,  and  the  selection  of  the  force  sensor.  Some  mathematical 
theory  has  been  developed  for  the  actuator,  not  only  for  its  performance  limits,  but 
also  for  its  control.  These  theories  have  been  tested  and  their  deficiencies  and  strong 
points  noted. 


8.2  Further  Work 

The  areas  of  further  work  fall  into  three  main  categories,  tying  up  lose  ends  of  the 
thesis,  improvements  of  the  actuator  itself,  and  further  development  of  the  use  of 
series  elasticity. 

In  chapter  6,  the  efficiency  of  the  motor  was  discussed.  It  would  be  good  to 
evaluate  how  the  efficiency  of  the  motor  system  changes  with  its  operating  conditions. 
This  would  allow  the  model  of  the  actuator  to  be  improved.  A  study  on  the  effects 


77 


78 


CHAPTER  8.  CONCLUSIONS 


of  backlash  on  the  system  performance  would  also  be  useful,  isolating  the  causes  for 
the  behaviour  seen  in  chapter  6. 

The  mechanical  design  of  the  spring  is  another  area,  where  further  work  would  be 
useful,  perhaps  finding  a  more  refined  model  of  the  spring  behaviour,  or  some  more 
design  guidelines.  This  would  ease  the  design  of  future  actuators. 

The  performance  of  the  actuator  could  be  improved  if  a  gearbox  with  a  lower 
backlash  was  chosen.  The  spring  does  lessen  its  effect,  but  if  there  was  less  backlash 
the  system  performance  would  be  better.  The  use  of  cable  transmissions  and  an 
alternative  type  of  spring  is  a  possible  avenue  of  research. 

The  electronic  hardware  for  the  actuator  is  quite  esoteric  and  awkward  to  work 
with,  however  it  seems  to  work  pretty  well.  A  proper  current  controlled  motor  driver 
and  more  resolution  in  the  A/D  channels  would  probably  increase  performance.  A 
controller  chip  with  floating  point  capability  which  could  be  programmed  in  something 
other  than  assembly  language  would  certainly  speed  up  future  development. 

Further  uses  for  series  elasticity  ha.ve  been  discussed  in  part  in  chapter  7.  The  main 
area  of  work  is  to  integrate  a  number  of  actuators  into  a  working  robot  manipulator, 
and  determine  the  overall  system  performance. 

Other  developments  include  using  two  actuators  coupled  in  parallel  to  achieve 
higher  force  control  bandwddth.  The  elasticity  isolates  each  motor  output  from  the 
load  so  they  can  be  tuned  to  have  performance  at  different  frequencies.  For  example, 
one  can  be  tuned  to  give  high  frequency  response  (using  high  gear  ratios  and  and  low 
spring  constants)  and  the  other  high  frequency  response  (low  gear  ratio  and  a  stiff 
spring).  The  overall  system  will  have  the  performance  of  the  sum  of  the  two  actuators. 
A  similar  idea  is  used  in  loudspeaker  design,  where  the  tweeter  (high  frequency)  and 
the  woofer  (low  frequency)  are  coupled  by  air  (elasticity)  to  give  performance  over  a 
wide  frequency  range.  This  idea  is  currently  being  investigated  at  MIT  by  Salisbury 
and  Morrell  [23]. 

Another  interesting  idea  is  to  use  variable  rate  springs,  where  the  changing  stiff¬ 
ness  alters  the  bandwidth  of  the  force  control  as  the  load  changes.  This  is  being 
investigated  by  Salisbury  at  MIT. 
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